Method And Control Means For Controlling A Robot

ABSTRACT

According to a method according to the invention for controlling a robot ( 1 ), in particular a human-collaborating robot, a robot- or task-specific redundancy of the robot is resolved, wherein, in order to resolve the redundancy, a position-dependent inertia variable (m n (Λ v (q))) of the robot is minimized.

The present invention relates to a method and control means for controlling a robot, in particular human-collaborating robot while resolving a robot- or task-specific redundancy.

Presently designated as a human-collaborating robot in particular is a robot that physically interacts with a human being, for example by providing for a stay of the human being in a workspace of the robot. In particular in the case of such robot applications it is desirable to reduce the consequences of a collision of a contact point of the robot with its surroundings, in particular the human being. Up to now, to this end, for example under ISO-10218, limits were predefined, for example a maximum TCP speed of 0.2 to 0.25 m/s. However, this worst-case approach impedes the performance of in particular human-collaborating robots.

In general the pose or position of a robot can be unambiguously described with f degrees of freedom by its joint coordinates q ε

^(f). At the same time, the position and orientation of a reference point or system of the robot, in particular of its TCP, can be predefined by its coordinates z^(T)=(x^(T)ε

^(m) _(s) ³ α^(T) ε

^(n) _(s) ³), where x for example describes the Cartesian coordinates of the TCP, α describes its orientation, say in Euler or Cardan angles. The difference f−(m+n) defines the redundancy of the manipulator. A robot-specific redundancy always arises when the manipulator has more than 6 degrees of freedom or joints, while a task-specific redundancy arises when fewer reference point coordinates are predefined than the manipulator has degrees of freedom, for example only the position of the TCP of a six-axle robot f−(m+n)=6−(3+0)=3). For more compact representation, also a six-axle manipulator with one or more additional axles, for example a portal or a tool bench, as well as a system of several manipulators cooperating with one another are generally referred to as a robot in terms of the present invention.

Descriptively, a redundant robot can constitute a predefined reference point coordinate vector in at least two, in particular in an infinite number of different redundant positions. In order to determine control quantities for the joint drives of the robot from predefined reference point coordinates, the redundancy must thus be resolved by calculation or one of the redundant positions must be selected.

To this end, up to now different quality criteria were minimized: thus the redundancy can be used to minimize the reciprocal value of the distance to singular positions and/or obstacles, to plan energy-efficient paths or the like.

The problem addressed by the present invention is that of improving the operation of a robot, in particular of a human-collaborating robot.

This problem is solved by a method with the features of claim 1 or a control means with the features of claim 10. Claim 11 protects a computer program product, in particular a storage medium or a permanent or volatile storage medium with a computer program for carrying out an inventive method stored on it, the subsidiary claims relate to advantageous improvements. A means in terms of the present invention can be designed likewise by software or by hardware; in particular it can comprise a program or program module and/or a processing and memory unit. A control means can hence likewise be a hardware control of a robot, in particular its control cabinet and/or a computer for programming the robot as well as also a program (subroutine) running in it.

The invention is based on the idea of using a redundancy of a robot to reduce the consequences of a collision of a contact point of the robot with its surroundings, in particular with the human being: a redundant robot has a different hazard potential in different redundant positions. By selecting a favorable position, for example in the case of a path plan, thus the consequences of a collision can be reduced in the case of constant operating speed. Similarly, it is possible to increase the operating speed and thus increase the performance of the robot.

In accordance with the invention, it is therefore proposed to minimize a position-dependent inertia variable of the robot to resolve the redundancy. A reduction of an inertia variable reduces the impulse or impact which the robot maps onto the obstacle in the event of a collision and thus its hazard potential.

In one preferred design this inertia variable, in particular on the basis of joint coordinates and/or a predefined direction, is determined in advance, i.e. offline, or during operation, i.e. online. The determination on the basis of joint coordinates projects the physical inertias, for example link masses, in the direction of the degrees of freedom of the robot and is therefore advantageous in order to resolve its redundancy. The determination on the basis of one or more predefined directions makes it possible to specifically minimize the hazard potential for this direction(s). In particular, the inertia variable can be determined on the basis of a predefined direction of movement and/or at least of a possible collision-direction of impact of the robot, which for example can arise from a path plan, a manual control for teaching or the like. If the robot moves in this predefined direction, it has a reduced hazard potential in the case of a collision.

In particular, the inertia variable can comprise, preferably be an effective mass, an effective moment of inertia and/or a pseudo matrix of the kinetic energy Λ_(v), Λ_(ω). In square format

$\frac{1}{2}{{\overset{.}{q}}^{T} \cdot {M(q)} \cdot \overset{.}{q}}$

of the kinetic energy the mass matrix M(q) describes the inertia properties of the manipulator in the configuration space. Also for redundant manipulators the Jacobi matrices of the translation and rotation

$J = \begin{pmatrix} J_{v} \\ J_{\omega} \end{pmatrix}$

the translational or rotational pseudo matrix of the kinetic energy Λ_(v), Λ_(ω) is defined by:

$\begin{matrix} {{{\Lambda_{v}^{- 1}(q)} = {\underset{\underset{J_{v}{(q)}}{}}{\left( \frac{\partial x}{\partial q} \right)} \cdot {M^{- 1}(q)} \cdot {J_{v}^{T}(q)}}}{{\Lambda_{\omega}^{- 1}(q)} = {\underset{\underset{J_{\omega}{(q)}}{}}{\left( \frac{\partial\overset{.}{\alpha}}{\partial\overset{.}{q}} \right)} \cdot {M^{- 1}(q)} \cdot {J_{\omega}^{T}(q)}}}} & (1) \end{matrix}$

where preferably one or more possible contact points of the robot, with which it could collide with its surroundings, in particular with a cooperating human being, or also an outstanding reference point such as in particular its TCP, a center of mass of a robot-guided useful load or an operating point of a robot-guided tool can be selected as a reference point with the coordinates z^(T)=(x^(T)α^(T)).

For a direction predefined by the unit vector u

$\begin{matrix} {{\frac{1}{m_{u}\left( \Lambda_{v} \right)} = {u^{T} \cdot {\Lambda_{v}^{- 1}(q)} \cdot u}}{\frac{1}{I_{u}\left( \Lambda_{\omega} \right)} = {u^{T} \cdot {\Lambda_{\omega}^{- 1}(q)} \cdot u}}} & (2) \end{matrix}$

describes the effective mass m_(u)(Λ_(v)) or the effective moment of inertia l_(u)(Λ_(ω)) along the direction or around the axis of rotationu, i.e. in each case on the basis of the direction u. They graphically describe the translational or rotational inertia of the (redundant) manipulator along the direction or around the axis of rotation.

In the following the invention will be further explained in particular using the example of the effective mass which arises for the TCP as a reference point and whose direction of movement is predefined by u. However, in addition or as an alternative, other directions, for example directions of movement, as result in the event of a malfunction of drives of the robot, and/or other points, for example vertices of the robot, which are especially collision-endangered, can be applied. In addition or as an alternative to one or more effective masses, for example eigenvalues of the pseudo matrices of the kinetic energy can be applied as inertia variables.

With the effective mass m_(u)(Λ_(v)(q)), a mathematical inertia variable can be determined for each position of the robot clearly predefined by the joint angle q. This can be used in one design as a quality criterion of a path plan. In the process, the inventive minimized inertia variable can constitute the only quality criterion of a path plan. Similarly, it can be taken into consideration, in particular as a weighted quality, together with other quality criteria such as an energy optimality, a distance to obstacles, unique, target and/or previous positions, for example in a Pareto- or functional optimization. Thus, for example in the case of a path plan the achievement of target positions can be predefined as a quality criterion or second-order condition, the minimization of the inertia variable as (a further) quality criterion.

In particular in the case of an optimization within the scope of a path plan or in the case of online control of the robot, for example when approaching reference positions to be taught, in one advantageous improvement a gradient of the inertia variable, preferably numerical, in particular discretized, can be determined and a position of the robot can be varied in one direction of this gradient. If the effective mass m_(u)(Λ^(v)(q)) is again applied as an example, a gradient has

$\begin{matrix} {{\nabla m_{u}} = {\left( \frac{\partial m_{u}}{\partial q} \right) \approx \left( \frac{{m_{u}\left( q_{2} \right)} - {m_{u}\left( q_{1} \right)}}{q_{2} - q_{1}} \right)}} & (3) \end{matrix}$

in the direction of the greatest increase of the effective mass. By changing the position in negative gradient direction corresponding positions can be determined with lower effective masses.

In addition or as an alternative to such a gradient-based minimization, an inertia variable can also be minimized in one preferred design by determining the associated inertia variable in each case for two or more redundant poses and selecting the pose with a lower, in particular with the lowest inertia variable. As becomes clear in particular from this, a minimization within the meaning of the present invention is defined in particular as the selection of a position which has a smallest inertia variable at least locally. In the process however, the invention is not restricted to such an absolute minimization; on the contrary, for improvement of the operation of the robot, in particular for reduction of its hazard potential and/or improvement of its performance through a higher operating speed it can be sufficient to select the position with the smaller inertia variable of two or more redundant positions. Therefore, for more compact representation, also a reduction of an inertia variable will be referred to generally as minimization of the inertia variable within the meaning of the present invention.

In particular, when a path of the robot is planned in advance, in one preferred improvement the inertia variable can be minimized for one or more, preferably discrete, in particular equidistant or signalized, for example taught path points. In the process, preferably the path tangent is applied as the predefined direction in the respective path point. If the robot leaves the path that has been planned in such a way, it has a reduced hazard potential preferably in its movement and thus one possible collision direction or said robot will be able to travel the path more rapidly at equal hazard potential.

In addition or as an alternative, the position with a minimized inertia variable can be determined in advance and, saved preferably in tabular form, also for one or more, preferably equidistantly distributed spatial points, in particular points of the configuration or workspace of the robot, in each case preferably for one or more directions, for example coordinate axle directions of a global coordinate system. During operation or in the event of planning a path, it is then possible to interpolate or extrapolate from the closest saved positions in order to resolve the redundancy. In this way in the event of low computer performance or CPU time a minimization of the inertia variable can be carried out by resolving the redundancy of the robot. In one preferred improvement the resolution of the redundancy can also take place in several stages, on the one hand for example by determining one or more redundant degrees of freedom in such a way that the inertia variable is minimized, and using other degrees of freedom for representation of predefined reference point coordinates and/or for optimization of other quality criteria. Similarly, optimum positions can also be determined with respect to the inertia variable and other criteria for redundancy resolution and from these positions, for example by averaging, interpolation or the like a position can be selected.

In one preferred design a position with minimal inertia variable is predefined as a reference position, for example as the initial value of an optimization. In one preferred improvement a virtual force is imprinted in the null space of the redundant robot, said virtual force harnessing its kinematics to the reference position, so that the robot approaches during operation or in the event of path planning of the reference position. Such null space can for example be imprinted in the case of path planning considering other quality criteria and/or second-order conditions in order at the same time to reduce the hazard potential or achieve better performance.

In the case of the minimization of the inertia variable one or more selected or likewise all degrees of freedom of the robot can be varied. For example, six joints, which represent a complete mapping of the workspace, can be used to achieve a predefined reference point position, further joints for minimization of the inertia variable. Similarly, it can be advantageous to vary one or more joint coordinates that are closest in basis, for example an angle of rotation for a link arm orcarousel, which are ordinarily represented by heavier robot links, for minimization of the inertia variable.

As explained above, by means of an inventive resolution of the redundancy while minimizing a position-dependent inertia variable of the robot its hazard potential, in particular in the case of constant speed of the robot, can be lowered. Likewise it is possible to increase the speed of the robot at constant or reduced hazard potential. To this end, in one preferred design of the present invention a speed of the robot is predefined such that a position-dependent momentum does not exceed a threshold.

The momentum can in particular contain, or in particular be a product of the inertia variable and of a power of a speed of the robot or one of its derivatives. If in one preferred improvement the inertia variable is the effective mass, its product with the speed of the reference point in the predefined direction of movement or also its product with the square of this speed can be determined as the momentum. The former corresponds to an impulse projected in the direction of movement; the latter corresponds to a kinetic energy projected in the direction of movement. If one correspondingly predefines the speed of the robot, at which for example it travels a geometrically predefined path, it can travel the path as quickly as possible, wherein its hazard potential, described by the projected impulse or the projected kinetic energy, remains below a predefined threshold.

Additional advantages and features arise from the subsidiary claims and the exemplary embodiments. To this end, the figures, partially in schematic form, show the following:

FIG. 1: shows a task-redundant robot in different positions and

FIG. 2: shows the course of an inventive method.

In an exemplary embodiment simplified for illustrative purposes, FIG. 1 shows a three-joint robot 1 with a heavy link arm 1.1 supported on a fixed base, a distinctly lighter arm 1.2 flexibly mounted to it and a light hand 1.3 flexibly supported on its end opposite the link arm with the TCP. All three rotary joints have parallel axes of rotation that are vertically upright on the drawing plane of FIG. 1.

If the task of a robot 1 consists in traveling a path B on the drawing plane with its TCP without consideration of its orientation, the robot is redundant with its three degrees of freedom q (q₁, q₂, q₃)^(T) with respect to the predefined position z=x=(x y)^(T): one recognizes that different, redundant positions exist to the same Cartesian TCP position (x, y) on path B on the drawing plane of FIG. 1 or the workspace of the robot, said different, redundant positions of which FIG. 1 shows three.

If one calculates the effective mass m^(u)(Λ_(v)(q)) for each of these positions according to Eq (2) with respect to the tangent unit vector u to path b in the point (, y), the lowest effective mass results for the position represented in solid lines, since here the projection of the mass of the massive link arm 1.1 disappears. Accordingly, in the case of planning a path for traveling path B with the TCP the redundancy is resolved as a result of the fact that for each sampling point the position with the lowest effective mass is selected and predefined as the target position. This can, as explained above, take place by determining the inertia variables m_(u)(Λ_(v)(q_(i,j))) for different redundant joint angle setsq_(i), which each yield the same TCP sampling position (x, y)_(j), and the selection of the joint angle combination with the lowest effective mass. Similarly, it is possible to determine in advance and save the position q*_(a,b,c,) with the minimum effective mass for equidistant spatial points (x_(a), y_(b)) and directions u_(c). In the planning of path B or likewise also with a manual online control of the robot 1 a position can then be automatically varied in the direction of the closest of these saved, hazard optimal positions whileretaining the TCP position and considering the predefined direction of movement. Instead of this, the effective mass, in analytical or numerical form equally, can also be considered as a quality criterion in the planning of the path.

FIG. 2 illustrates this method in schematic form: in a first step S1 sampling points (x, y)₁, (x, y)₂, . . . are predefined for the TCP in order to travel path B with said TCP.

Then, in step S2 a predefined direction of movement u₁ is first determined for each of these sampling points (x, y) as a unit tangent vector to the path.

Then, in an optimization the position cr, is determined, which meets the second-order condition (“NB”): (x,y)(q*_(i))=(x, y)_(i), i.e. in which position the TCP occupies the predefined sampling point, and in the event that the effective mass m_(u)(Λ_(v)(q*_(i))). according to Eq (2) is minimal, i.e. less than the effective mass m_(u)(Λ_(v)(q_(i))): or at least one other redundant position, for which the following applies: (x, y)(q_(i))=(x, y)_(i).

Finally, in a step S3 the driving speed {dot over (q)}_(i) of the robot is defined such that a function, in particular the product of the effective mass and the Cartesian TCP speed ({dot over (x)},{dot over (y)})_(i)=Ψ({dot over (q)}_(i)).emains below a threshold. As becomes clear from this, the speed which is predefined (here the joint angle speed {dot over (q)}_(i)′.) and the speed which is used for determining the inertia variable do not have to be identical, however this can be the case if for example the TCP speed is predefined. 

1-11. (canceled)
 12. A method for controlling a robot, in particular a human-collaborating robot, wherein a robot-specific or task-specific redundancy of the robot is resolved, comprising minimizing a position-dependent inertia variable of the robot for resolution of the redundancy.
 13. The method according to claim 12, wherein the inertia variable includes at least one of an effective mass, an effective moment of inertia, or a pseudo matrix of the kinetic energy.
 14. The method according to claim 12, wherein the inertia variable is determined in advance or during operation.
 15. The method according to claim 12, further comprising using the inertia variable as a quality criterion of a path plan.
 16. The method according to claim 12, further comprising: determining a gradient of the inertia variable; and varying a position of the robot in a direction of the determined gradient.
 17. The method according to claim 12, further comprising: determining the inertia variable for at least two redundant positions, in particular to at least one path and/or spatial point; and selecting the position with the lower inertia variable.
 18. The method according to claim 12, further comprising: predefining a position with minimal inertia variable as a reference position.
 19. The method according to claim 12, further comprising: varying one or more degrees of freedom of the robot for minimization of the inertia variable.
 20. The method according to claim 12, further comprising: predefining a speed of the robot such that a position-dependent momentum does not exceed a predetermined threshold.
 21. The method according to claim 20, wherein the position-dependent momentum contains a product of the inertia variable and a power of a speed of the robot or one of its derivatives.
 22. A controller for controlling a human-collaborating robot, the controller comprising: a processing unit; and a memory unit operatively coupled to the processing unit and containing a program that, when executed by the processing unit, causes the controller to resolve a robot-specific or task-specific redundancy of the robot by minimizing a position-dependent inertia variable of the robot.
 23. A computer program product comprising: a non-transitory computer readable storage medium; and a program stored on the non-transitory computer readable storage medium that, when executed by a processing unit, causes the processing unit to resolve a robot-specific or task-specific redundancy of the robot by minimizing a position-dependent inertia variable of the robot.
 24. The method according to claim 14, wherein the inertia variable is determined on the basis of at least one OF joint coordinates or a predetermined direction. 